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Abstract: 

We are interested in Voronoi diagrams as a tool in robot path planning, where the 
search for a path in an r dimensional space may be simplified to a search on an r — 1 
dimensional Voronoi diagram. We define a Voronoi diagram V based on a measure of 
distance which is not a true metric. This formulation has lower algebraic complexity than 
the usual definition, which is a considerable advantage in motion planning problems with 
many degrees of freedom. In its simplest form, the measure of distance between a point and 
a polytope is the maximum of the distances of the point from the half-spaces which pass 
through faces of the polytope. More generally, the measure is defined in configuration spaces 
which represent rotation. The Voronoi diagram defined using this distance measure is no 
longer a strong deformation retract of free space, but it has the following useful property: 
any path through free space which starts and ends on the diagram can be continuously 
deformed so that it lies entirely on the diagram. Thus it is still complete for motion 
planning, but it has lower algebraic complexity than a diagram based on the euclidean 
metric. 
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1 Introduction 


The Voronoi diagram has proved to be a useful tool in a variety of contexts in computational 
geometry. Our interest here is in using the diagram to simplify the planning of collision-free 
paths for a robot among obstacles, the so-called generalized movers’ problem. The Voronoi 
diagram, as usually defined, is a strong deformation retract of free space so that free space 
can be continuously deformed onto the diagram. This means that the diagram is complete 
for path planning, i.e. Searching the original space for paths can be reduced to a search on 
the diagram. Reducing the dimension of the set to be searched usually reduces the time 
complexity of the search. Secondly, the diagram leads to robust paths, i.e. paths that are 
maximally clear of obstacles. 

The Voronoi diagram generated by a set of points in a Euclidean space partitions the 
space into convex regions which have a single nearest point under some (usually L 2 ) metric. 
A generalized Voronoi diagram can be defined for points and line segments in the plane 
(Lee and Drysdale, 1981) which partitions the plane into (generally non-convex) regions. 
In both cases the diagram is defined to be the set of points equidistant from two or more 
generators under the appropriate metric. This construction has proved to be useful for 
motion planning among a set of obstacles in configuration space (see O’Dunlaing and Yap 
(1982), O’Dunlaing, Sharir, and Yap (1984), Yap (1984), and the textbook of Schwartz 
and Yap (1986) for an introduction and review of the use of Voronoi diagrams in motion 
planning). Its virtue for motion planning is that the diagram is a strong deformation retract 
of free space, i.e. the space outside the obstacles can be continuously deformed onto the 
diagram. To find a path between two points in free space, it suffices to find a path for 
each point onto the diagram, and to join these points with a path that lies wholly on the 
diagram. 

The simplified diagram has lower algebraic complexity than the L 2 diagram. For ex¬ 
ample, in 9fi 3 , the L 2 diagram about polyhedral obstacles consists of quadric sheets; the 
simplified diagram is piecewise linear. In 3£ 2 , the simplified diagram for polygonal obsta¬ 
cles is a graph of straight lines, see fig. 1. In general, the simplified diagram has the same 
degree as the algebraic obstacle constraints. However, it may not have linear size in the 
worst case. 

One useful aspect of the simplified Voronoi diagram is that it is naturally defined for 
the six dimensional configuration space of an arbitrary 3D polyhedron moving amidst 3D 
polyhedral obstacles. In general, it has been considered difficult to define such a Voronoi- 
type diagram in this case. Our definition elaborates a suggestion of Donald (1984) and 
Canny (1985), who describe certain Voronoi-like properties of the algebraic set U ,&> ker(C' t — 
Ci>) for a set of algebraic constraints { C, }. 

2 Object-Obstacle Constraints 

We briefly derive conditions for overlap of two polyhedral objects A and B. A more 
complete derivation of an equivalent condition is given in Canny (86). The form we derive 
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here is different from (Canny 86) in that it uses a local test for non-overlap, rather than 
overlap. We assume first that A and B are convex, and then generalize to the non-convex 
case by taking the conjunction of pairwise non-overlap predicates between convex pieces. 

The overlap predicates in Canny (86) generate a shallow (depth 2) AND-OR predicate 
tree, whose root is a disjunction. It will be advantageous to make the predicate tree as 
deep as possible and it is also desirable for the root to be a conjunction. So instead we use 
the following test based on conditions for non-overlap. 

Definition. 

For any face / of a convex polyhedron A , the affine hull f of / is the plane which 
contains /. 

The affine hull of a face / defines two closed half-spaces, one of which contains A. We 
call this half-space the interior half-space , and denote it / . 

Finally, we define the wedge of an edge e of A as the intersection of the two interior 
half-spaces of the faces which cobound e. The wedge of e is denoted e, and it contains A. 

Lemma. Two convex polyhedra A and B are non-overlapping iff all edges of A (or B ) 
are outside some wedge of an edge of B (resp. A). 

Proof. This condition is clearly sufficient for non-overlap, by convexity of A and 
B. Conversely, if A and B are disjoint, then there is a (not necessarily unique) non-zero 
shortest vector between them. Let p a and ps be the end-points of this vector in A and B 
respectively. If one of these points lies in the interior of a face /, then the test succeeds for 
any wedge of an edge in the boundary of /. If one of the points lies in the interior of an 
edge e, then the test succeeds for e 

The only case remaining is where p a and ps are both vertices. Let / be a face adjacent 
to pjy, and such that ps lies outside the interior half-space / , (there must be at least one 
such /, or ps would be contained in A). Then if B is also outside this half-space, the test 
succeeds for the wedge of any edge that cobounds /. 

Otherwise, let W PB be the intersection of the wedges of all edges that cobound ps- Let 
S be the plane passing through ps and normal to the vector ( Pb~Pa )• S defines two closed 
half-spaces, one (5^) containing A and the other ( Sb ) containing both B and W PB , i.e. S 
separates A andThen the intersection (W PB fl /) lies in (Sb H /). Let p 0 be the closest 
point in ( W PB fl /) to (S fl J). Then p 0 is in the boundary of some wedge e of an edge e that 
cobounds ps- Now (e fl /) C (Sb fl /) and so by projection from ps, (e D / ) C (Sb D / ). 
But A C (Sa H / ), so (e fl A) = 0, and the test succeeds for e. □ 

Thus we can define the following predicate for non-overlap Fa,b of A and B from the above 
test: 

V A f«*,)v( V A r**, 

ej€ e,- 6 ' ^ e,6 ej 6 

edges(B) edges(A) edges(/l) edges(B) 
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where F- e ^ Sj = ((e,- ft ej) = 0). The corresponding condition for overlap is in the form of a 
conjunction of disjunctions, as desired, and this is the form we will use in our development. 
If the object consists of several convex pieces A,, as do the obstacles Bj, then the non¬ 
overlap predicate is the conjunction of pairwise predicates 

F = A A (2) 

* j 

We must now decompose the non-overlap predicate for a wedge e A of A and a edge 
eg of B into simple geometric predicates that can be computed directly. These geometric 
predicates are Af tP , Cg AtC and C~ e . Af tP indicates non-overlap of a vertex p of B and 
the interior half-space of a face / of A and is given by 

A f, P = ( n / • P ~ cj > 0) (3) 

where n/ is the outward normal of /, and cy is its distance from the origin. For C+ e 
and C~ A>eB we need the following definitions: Let d A and dg be the vector directions of e A 
and eg respectively, and let p A be any point on e A . Let and H and T be the head and tail 
vertex respectively of eg, then we have 

Ct,*B = (X - Pa) ■ Va X da) > o ( 4 ) 


c *a,’b = Pa) ' (“*4 x d B ) < 0 

Now we can define Fe A>eB in terms of the above predicates, and L and R which are the 
left and right faces respectively, which cobound eg , (left and right are determined here by 
viewing e B from outside eg with dg upward). 

F e A ,e B = ((Al,h A i A L,T V (AR t T A C+ A<eB ))) , , 

v ( A Rt H A (A Rt T v (A LyT a C~ A<eB )))) 

The predicate F- eA ^ B can be written in the equivalent form: 

^e A ,e B ~ {Al,H V ARtf) A ( Al,T V Ar,t) 

A (A Lt H V A Rt T V C+ AteB ) A ( A r<h V Al,t V C~ A<eB ) 

There is a similar form for the predicate F tA ^ B . From (1), (2) and (6) we see that the 
overall form of the non-overlap predicate can be written as 

c = AVAV(c««>») (?) 

i j k l 
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3 The Voronoi Diagram 

For motion planning, the configuration of object A is variable. For a polyhedron in three 
dimensional space, the configuration contains a position x 6 $ 3 and an orientation q £ 
S0{ 3) component, where SO( 3) is the group of three-dimensional rotations. Thus the 
face normals, vertex locations, and edge directions of A are all functions of x and q. The 
predicate (7) is now also a function of the configuration (x, q), i.e. 


^(x,q) = A V A > 0) 


( 8 ) 


j k l 


The forms of the functions C^-fc^x, q) are given explicitly in Canny (1986), and they 
are algebraic if, say, a quaternion representation of rotation is used. The set of overlap 
configurations is called the configuration obstacle and is denoted CO = {(x, q)|->F(x, q)}. 
It may be thought of as a physical obstacle in configuration space to be avoided by a path 
planner. We now observe that by letting positive real values represent logical one, and 
non-positive values represent logical zero, that the min function implements logical AND, 
and the max function implements logical OR. Thus an equivalent form to (8) is 


F(x, q)= ( ( min(max(min(maxC',jfc/(x, q 

\ \ * 3 k l 


>0 


which suggests that the quantity 


p(x,q) = min(max(min(maxC , , jfc ,(x,q)))) 

t 3 ft * 


(9) 


( 10 ) 


can be used as a measure of distance from the configuration obstacle, because it varies 
continuously through configuration space, is positive at configurations outside CO, and 
non-positive at configurations inside CO. Thus the configuration obstacle can be rewritten 
as CO = {p | p(p) < 0}, and its complement, the set of points in free space can be written 
F = {P I /(p) > o}. 

In order to define the Voronoi diagram under the distance measure p, we need a notion 
of closest feature. The closest features to a configuration (x, q) are those Cijki which are 
critical in determining the value of p(x, q), that is, small changes in the value of Cijki cause 
indentical changes in the value of p. 


Definition. 

A constraint Ci 0 j 0 k 0 i 0 £ {Cijki} is critical at a configuration (x, q) if the value of 
CiojokoioiXi q) equals the maximum (or minimum) value of every max (resp. min) ancestor 
of Ci 0 j 0 k 0 i 0 in the min-max tree in (10). i.e. 


c 'foiB*ofe( x »q) = max Ci 0 j 0 k 0 i(x, q) = rnin(max C l0J0 ki(x, q)) = . 


( 11 ) 


Now we have 
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Definition. 

The simplified Voronoi diagram V is the set of configurations in free space F at which 
at least two distinct constraints are critical. 

It should be clear from the definition of criticality that V is semi-algebraic if the con¬ 
straints Cijki are algebraic. V is closed as a subset of free space, although it is not closed in 
configuration space. Notice that V has no interior, since it is contained inside a finite set 
of bisectors, each of which has no interior. A bisector is the zero set of ( C, 0 j 0 k 0 i 0 — Ci in k 1 i 1 ) 
for some pair of distinct constraints. It will prove useful to subdivide the Voronoi diagram 
into two parts: 

Definition. 

The concave part of the Voronoi diagram V denoted conc( V) is the set of configurations 
in F where two distinct constraints are critical, and the lowest common ancestor of these 
constraints in the min-max tree of (10) is a min-node. 

The convex part of the Voronoi diagram V denoted conv(V) is the set of configurations 
in F where two distinct constraints are critical, and the lowest common ancestor of these 
constraints is a max-node. 

Notice that these two definitions are not mutually exclusive, because there may be 
points where more than two constraints are critical, and which satisfy both definitions. 
Thus conv(V) and conc(V) may overlap. 

4 Completeness for Motion Planning 

Our key result is that any path in F with endpoints in V can be deformed (in F) to a path 
with the same endpoints lying entirely in V. We start with a path p : I —► 3£ 3 x SO(3) 
lying in free space, p(I) C F, where I = [0,1] is the unit interval. 

First we assume wlog that p intersects V at a finite number of points. We can do this 
because, as defined in the previous section, V is a semi-algebraic set, and by Whitney’s 
(1957) result, it can be split into a finite number of manifolds, or strata. Since V has no 
interior, all these manifolds have codimension at least one. For any path p there is a path 
p' arbitrarily close to p, which is an embedding of 7, and so p'(I) is a 1-manifold. Almost 
every perturbation of p' intersects all of the strata transversally, and therefore at a finite 
number of points. We can choose such a perturbation to be arbitrarily small, in particular, 
smaller than the minimum distance from p\I ) to CO. Such a perturbation gives a new 
path p" which is path homotopic to p, and which has finite intersection with V. 

So we assume that p has m intersections with V, and that these occur at points p(x t ) 
with ar x ,... x m (E 7, and x x = 0 and x m = 1. We then break each interval [a:,-, ar* +1 ] in half, 
giving us two intervals sharing an endpoint. Thus we now have 2m—2 intervals each of which 
intersects V at only one endpoint. Below we give homotopies for each of these intervals 
which continuously deform the image of the interval onto V. Since all these homotopies 
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agree at their endpoints, they can be pasted together to give us a global homotopy which 
deforms p onto V. For simplicity, we assume the path segment is parametrized in the range 
I = [0,1] and that p(0) £ V. 

The motion constraints Cijki are either A or C predicates, (3) and (4), and all can be 
written in the general form below, called the parametrized plane equations by Lozano-Perez 
(1983). 


C'tj*/(x,q) = Ntf W (q) ■ x + Ctf W (q) (12) 

Where N^*/(q) £ 3ft 3 and c tJ fc/(q) £ 3ft are both continuous functions of q. We assume 
that the Cijki are normalized so that |Njjt/(q)| = 1 for all q. Our objective is to continuously 
deform the path p onto the diagram, and we use the as ‘normals’ to push a point on 
the path p(I) away from the critical Cijki • We assume that the set of positions is bounded 
by some set of constraint ‘walls’ of the same form as (1), so that a point can be displaced 
only a finite distance in free space. We also assume that the workspace has unit diameter. 

General position assumptions. The construction requires the following general 
position assumptions. First, suppose Cijki is type C predicate (4). Then N,yfc/(q) = d^(q) x 
(Ib- To normalize N,■_,•*/, we must divide by its magnitude, which must remain non-zero. 
Hence the set of configurations 

{ q I ^(q) x dfi = 0 } C SO(3) (13) 

must not intersect the image of p. However, (13) is clearly of codimension 2 in 50(3), and 
hence by Sard’s lemma there is always an arbitrarily small perturbation of p which avoids 

(13) \ 

Similarly, the set 

{ (x, q) | (N,j*<(q) = N,/j<fc»;/(q)) A (0; ifc ,(x, q) = Ci>j> k >i>(x., q)) } (14) 

is also of codimension > 2 in 3ft 3 x 50(3), and we assume that p avoids it as well. 

We must define two different homotopies depending on whether p(0) £ conc(V), which 
is the simplest case, or p(0) £ conv(V). 

Notice that since p(0) is the only point on the path which is in V, there is exactly one 
constraint which is critical at all configurations in p(0,1] (since constraints change value 
continuously along the path and for another constraint to become critical, it must first 
equal the first constraint, which can only occur at points on the diagram). Let the critical 
constraint be Cijki- We define a homotopy J 0 : I x I —► 3ft 3 x 50(3) as 

J 0 (t, u ) = p(t) + uJAijki(TT q (p(t))) (15) 

where ir q (p(t)) is the orientation component of p(t) and the addition symbol means we add 
the vector quantity u’Nijki(n q (p(t)) to the position component of p(t). The deformation 
above pushes points beyond the diagram, so we define a second homotopy J\ : I x I —► F. 
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J\(t,u ) = Jo(*,niin(u,u c (t))) 


(16) 


where u c (t ) = inf {5 | J 0 (t,s ) E conc(V) } 

Recall from the definition of homotopy, that J\ is a homotopy of p and a path p' if J\ is 
continuous and Ji(t, 0) = p(t) and Ji(t, 1) = p'(t). The homotopy J\ suffices to map paths 
with one endpoint in conc(V) onto V: 

Lemma 4.1 Let p : I — ► 3ft 3 x 50(3) be a path having p(0) E V and no other points 
in V. Then is a homotopy of p and a path p' such that p'(I) C conc(F). Furthermore 
p'(0) = p(0) if p(0) E conc(V). 

Proof. From the definition of Jj we have Ji(t, 0) = p(t) and J\{t, 1) E conc(V). Also if 
p(0) E conc(F) then u c (0) = 0 so p'( 0) = p(0). It remains to show that J x is continuous. 
First we notice that Jq is continuous. Continuity of Ji follows if we can show that u c (t) is 
continuous. Now Jo(t, u c (t)) is contained in the zero sets of all bisectors {{C^yk'i' ~ Cijki)}- 
Let u' c (t ) be a deformation onto a particular bisector: 

u'(t) = inf{u| J 0 (t,u) E ker((7 jV fc'/' - C m )} (17) 

then u' c is continuous because by definition 


(Cijki — c , « , j , * , *')(*M^“c(*))) = 0 

and differentiating 

§i(Cijki - Ci'j'k'i')(Jo(t,u ' c )) + (Jjf) r(Cijki - Ci>j'k>i>)(Jo(t,u ' c )) = 0 
rearranging we obtain 


(18) 

(19) 


d u c _ Q t {Cjjkl Ci'j'k'l’)(Jo(t ) <)) . . 

9t £r(C ij ki-C i , j ,kn')(Mt,K)) { } 

and therefore ^u'(t) is finite, because the denominator above is non-zero by our general 
position assumption. Now we observe that u c (t ) can be constructed by pasting together 
segments of u' c {t) for various bisectors E conc(F), and we must show that they agree at 
their endpoints. The proof is by contradiction. Suppose we had 



for t E (t 0 , *i]; 
for tE (h,t 2 ); 


( 21 ) 


with «'(f x ) ± u"(<j) 

for u' and u" derived from distinct bisectors. Then since u c is the m i n imum of all such u, 
we must have u' c (ti) < u"(ti) 
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But this means that as u increases, Jo(ti, u) crosses two bisectors in conc(V) between 
Cijki and other constraints. This is impossible because all constraints C have |N(q)| = 1, 
and it follows that 


< 1 ( 22 ) 

That is, all constraints increase no faster than Cijki with the deformation parameter u. By 
our general position assumption if Cijki ^ Cy^M, then the inequality in (22) is strict, and 
so if the clause Ci'j'k'V becomes critical at u' c , it shares a min node lowest ancestor with 
Cijki • Since all constraints in the tree increase more slowly than Cijki, the value of this min 
node will be less than the value of Cijki for u > u' c (ti). Therefore Cijki cannot be critical 
for any u > u'(ti), contradicting the assumption that u"{tx) is distinct from u'(fi). So all 
bisectors in conc(F) between Cijki and other constraints agree at their endpoints, and u c (t) 
is continuous by pasting. This shows that J\ is continuous. □ 


If p(0) € conv(F) the situation is more complicated, because the deformation J 1 pushes 
p(0,1] away from p(0). To correct this, we first compress the first half of p to a point: 


Lemma 4.2 Let p : I —► F be a path in free space. Then p is homotopic to a path p' 
such that 

(i) p'([o, |D = P(0) 

(ii) p'(l) = p( 1) 

(iii) P'(I) = P(I) 


Proof. The required homotopy is 


J(t,u ) 

so J(t, 0) = p(t), and J(t, 1) = p'{t). 


( p(0) if t < 
l P (j^r) otherwise; 

□ 


(23) 


We apply the homotopy of lemma 4.2 to p to give us a path p'. Applying the homotopy 
Ji to the path segment / >/ |[^.,i] continuously deforms this path segment onto conc(V'). Then 
we define a new homotopy which slowly “unravels” p'lfo.i] from p(0). All the points in this 
homotopy have the same orientation, and for each value of the deformation parameter u, 
the path consists of a finite number of straight line segments. 

The construction is inductive and we start with a homotopy that gives us two straight 
line segments. If the orientation at the configuration p(0) is q 0 , every point on the joining 
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path will also have orientation q 0 . We define two vectors in position space No and M 0 
which will be used to define the joining path segment. 

Let Cijki and be the two constraints that are critical at p(0), then No lies in the 

plane of the bisector of Cijki and Ci'j'k'i'- N 0 is normalized so that N 0 • Njjfcj(q 0 ) = 1 and it 
follows that N 0 -Nj/j/ fc ///(q 0 ) = 1. A second vector M 0 is chosen so that M 0 +Njjfc/(q 0 ) = N 0 , 
and so: 


N 0 = 


N jjkl + N t '/j<fc<;/ 

1 -f Njjjfc/ • N iijik'v 


(24) 


M — (Njjki • N,»j/ fc /;/)N 8 jfc/ 

1 + N iju • Ni>j>k>i' 

where N ijki (shorthand for Njjfc/(q 0 )) is the normal vector to the critical constraint Cijki 
at orientation q 0 , and N i'j'k'v = N t yfc///(q 0 ) i s the vector normal to the critical constraint 
Ci'j>k>v- 

We can now define the joining homotopy J 2 : I x I —* 5ft 3 x SO{ 3) which deforms the 
path segment p'|| 0 i] (with p' reparametrized so that its domain is I): 



J 2 (t,u) 


p(0) + 2£N 0 , if t € [0, \u]; 

* p( 0) + wN 0 , if t e. [|u, 1 — |u]; 

. P(0) + (2 - 2t)M 0 + uNyjt((q 0 ), if t e [1 - \u, 1]; 


(26) 


Now No lies in the plane of the bisector of the two constraints that are critical at p(0), 
but it is possible that as u increases, J 2 (|, u) leaves the convex part of the diagram before 
reaching the concave part. That is, there may be bends in the convex part of the diagram 
which must be tracked. We must therefore stop the deformation at this point by defining 

u v = sup{u | Cijki is critical throughout J 2 (|, [0, u]) (27) 

and once again we define a homotopy which stops points when they reach the diagram: 

J 3 (t, u) = J 2 (t, min(u, u v , u c (t ))) (28) 


where u c (t) = inf{ u \ J 2 (t,u) € conc(V) }. 

and then we have: 

Lemma 4.3 Let p : I — * 5ft 3 x ,9(9(3) be a path having p(/) = p(0) € conv(V). Then J 3 
is a homotopy of p and a path p' such that 

(i) p'(O) = p(0) 

(ii) p'([0,1 - !«„]) C conv(V) 

(iii) p'((l - $u v , l])nVc conc(L") 
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Proof. 

Parts (i) and (ii) follow immediately from the definition of J 2 and J 3 . Part (iii) states 
that points in the interval (1 — 1] that are mapped into the diagram by p' are mapped 

into the concave part of the diagram. For this we notice that 

= N i)W (q 0 ) (29) 

for t > 1 — ju, while J 2 (t,u) E conv(V) if t < u. Therefore for t > 1 — the following is 
true: 


du ~ ^ 

dCijki(J2(tn u )) 1 
du 

So as u increases, all constraints increase no faster than Cijki- So another constraint 
can only become critical if its lowest common ancestor with Cijki is a min node, and such 
a configuration must be in conc(F). 

For continuity of J 3 , first we notice that J 2 is continuous, and J 3 will be continuous if 
u c (t) defined in (28) is continuous. For this we notice that the use of u v in the min function 
in (28) guarantees that Cijki is critical at configuration J 3 (t, u ) for all t and u. The rest of 
the proof of continuity is identical to the proof of continuity of u c (t) in lemma 4.1, using 
the rate of change condition in (30). □ 

Lemma 4.4 If p : I —► F is a path having p([0, |]) = (p(0)} C conv(V) then p is 
homo topic to a path p' : I —> V such that p'(0) = p(0). 

Proof. The proof is inductive. We define a sequence of partial homotopies, that is, 
maps J n : I x [u" -1 ,u n ] —> F such that J n (t,u n ) = J n+1 (t,u n ). Then we show that the 
number m of partial homotopies required is finite. 

Inductive hypothesis. The input to our construction is a path p n , a value of u n E I , 
and points an d in I such that 

(i) p n (t) E conv(F) for t < t£ 

(ii) P n ([<S,f?]) = {P n (to)J C convOO 

(iii) Cijki is critical on p n {I). 

From Cijki we use lemma 4.1 to define a homotopy J\ for the path segment p n \[q,\] 
(reparametrized to I). Similarly, let Ci/j>k>i> be a constraint which is critical at p n (t 3 ) 
and whose lowest common ancestor with Cijki is a max node. For these two constraints, 
we use Lemma 4.3 to define an unravelling homotopy J 3 of the path segment p n |[ t n jt n] 
(reparametrized to I). This gives us a value of u v as in (27), and we define u n+1 = u n + u v . 
Now J n+1 can be defined on the range u E [«”, u n+1 ] as: 
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(31) 


J “ +1 = 


■ P n {i) 

for t € [0,ig]; 

< u u ) 

forie 

*^1 u ) 

for t £ [t”, 1]; 


then J n+1 is a homotopy because J 3 and J\ agree on their intersection, and J 3 (0, u) = p n (t%). 
We can define a new path p n+1 (t) = J n+1 (t, u n+1 ) and points 


C = <S + y«-<S) *■><• C' = C-yW-ffl (32) 

and it is readily verified that these satisfy the inductive hypothesis. 

For the base case, we set p° = p, u° = 0 and ^ = 0, t® = |, which clearly satisfies the 
inductive hypothesis. 


Finiteness. For termination, we must show that after a finite number of steps m, 
P m (t<o ) £ conc(V). Suppose p n (t%) ^ conc(V), and let Ci'j'k'i' be the constraint (along 
with Cijki) which is critical at p n ([to -1 , to]), i- e - these are the constraints used to define the 
homotopy J 3 for J n . A third constraint is also critical at p n (fg), by (27). This 

constraint has a max node lowest common ancestor with Ci'j'k'i', which implies that 

< ^•C'i"j»fe»;»(J 3 (|, «)) (33) 

and from (24) it follows that 

(Nijki + Niij'kni) ■ Niij'k't' < (Nijki + Ni'j'k'i ') • (34) 

which implies 


Nijki • Ni'j'k'i 1 < Nijki • Ni"j"k»i» (35) 

but the condition (35) defines a total ordering on the constraints distinct from Cijki • That 
is, as u increases and p n (tg) is deformed according to some J 2 , a new constraint Ci"j"k»i» 
can only become critical if it satisfies condition (35). Once Ci"j"k"i» has become critical, 
Ci'j'k'i' can never again become critical. Thus we need define homotopies J n at most once 
for each constraint, and so their number m is bounded by the number of constraints. 

We then construct J\ for the path segment p m \[t™,i] reparameterized to I. The final 
homotopy is defined for the range u £ [u m , 1] as: 


then the homotopy 



for t £ [0,t™]; 
for t £ [t™, 1]; 


(36) 


J 4 (t,u) = J n (t,u) with u £ [u n 1 ,u n ] for ra = l,...m + l (37) 
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is continuous, and defines a homotopy between p(t) = J 4 (f,0) and a path p'(t) = J 4 (t,l) 
such that p'(I) (ZV. □ 

Theorem 4.1 Let p : I —► F be a path with endpoints in V. Then p is path homotopic 
in F to a path p' with the same endpoints which lies entirely in V. 

Proof. We first apply the homotopy of lemma 4.2 to all path segments p\[t n ,t n+1 ] with 
an endpoint in conv(V). This does not displace endpoints in V. Then we construct a 
global homotopy J by pasting together homotopies J x for path segments with an endpoint 
in conc(V), and homotopies J 4 for the remaining path segments. The resulting homotopy 
is continuous if these homotopies agree at their endpoints. Firstly, both J x and J 4 to not 
displace endpoints in V. Therefore they agree at endpoints in V. At free endpoints both 
satisfy the free endpoint condition : Assume that after reparametrization, p(l) is a free 
endpoint. Then 


J,(l,u) = p(l) + min(u, u c )N ijkl for i = 1,4 (38) 

with u c = inf{u| p(l) + uNijki £ conc(V)} 

thus J is continuous, and we define p'(t) = J(t, 1). Since Ji(7,1) C V and J 4 (I, 1) C V, 
we have p\I ) C V. □ 

Finally, suppose that in a motion planning problem we are given a start configuration 
(x, q) which is not on V. Then exactly one constraint Cijki is critical there. We apply 
the homotopy J\ to the constant path at (x, q) to attain the diagram; that is, we plan a 
straight-line path in direction N,jfc/(q) to reach V from the start. 

The completeness condition for motion planning has the following simple algebraic 
formulation. Let i : V F be the inclusion map. Then if V is a euclidean Voronoi 
diagram, then it is a strong deformation retract of F, and hence i induces an isomorphism 
of fundamental groups. In our case we have the weaker completeness condition that i 
induces an epimorphism: 

Corollary. (Algebraic formulation of the completness condition for motion planning). 
Let i : V e —► F be the inclusion map of the simplified Voronoi diagram in free space, with 
Vo £ V i and let tti(X 1 x) denote the fundamental group of X with base point x. Then the 
induced homomorphism i* : 7r a (V,y 0 ) —► n x (F,yo) is surjective. 

Hence the fundamental group of F is isomorphic to the quotient group 7r 1 ( V, y 0 ) / ker i x . 
This quotient measures the structural difference between F and V. 
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5 Complexity bounds 

We have given a definition of the simplified Voronoi diagram V in the configuration space 
of a polyhedron in 3-space. This definition does not constitute an algorithm, so our bounds 
depend on the algorithm used with the diagram. We assume that the diagram will be used 
as input to a version of the roadmap algorithm of Canny (1986a). This algorithm computes 
one-dimensional skeletons of semi-algebraic sets in time (d°^n r logn) for a semi algebraic 
set defined by n polynomials of degree d in r variables. In our case the number of variables 
and the degree of the equations are constants. 

A naive bound on the complexity of computing a skeleton of V would be 0(n 12 logn) 
if we are given n constraints, because the diagram is a subset of the zero sets of all 0(n 2 ) 
bisectors of constraints. This bound can be reduced to 0(n 7 logn) by noticing that the 
diagram has a simple stratification (decomposition into a union of disjoint manifolds). The 
diagram is a subset of the set of all m-sectors, where an ra-sector is the set of points where 
m constraints have the same value. If the constraints are in general position, each m-sector 
is a manifold of codimension m — 1. There are 0(n m ) m-sectors, and by the codimension 
condition, m must be less than or equal to 7. The complexity of computing the skeleton 
of this stratification is 0(n 7 logn). 

While its worst case bounds are poor, the actual performance of the algorithm is ex¬ 
pected to be much better, because V approximates the euclidean Voronoi diagram, as 
shown in figures 1 and 2. The evidence for this is that the complexity of the euclidean 
Voronoi diagram for a set of n points in r dimensions is 0(n^ 2 ^J), and the euclidean 
Voronoi diagram for disjoint line segments in the plane has linear size. 

This conjecture is supported by some experimental evidence. We have implemented an 
algorithm for constructing the simplified Voronoi diagram for the following configuration 
spaces: 3J 2 , the case of an arbitrary polygon translating in the plane amidst polygonal 
obstacles, and S 2 x 5 1 , which allows the moving polygon to rotate as well as translate. In 
many cases the size of V has been observed to remain roughly linear, as in fig. 1, which 
our implementation produced. 
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